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Abstract 

A general family of asymptotically stabilizing control laws is introduced for a class of 
nonlinear Hamiltonian systems. The inherent passivity property of this class of systems 
and the Passivity Theorem are used to show the closed-loop input/output stability 
which is then related to the internal state space stability through the stabilizability 
and detectabilty condition. Applications of these results include fully actuated robots, 
flexibe joint robots, and robots with link flexibility. 
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1 Introduction 

Inherent passivity in fully actuated mechanical systems has long been recognized and ex- 
ploited for their stabilization [1,2]. However, when some degrees of freedom are not directly 
actuated, for example, in flexible robots, the passivity property becomes less useful as damp- 
ing can only be directly added in certain subspace. 

In this paper, we present a family of asymptotically stable set point and tracking con- 
trollers for a class of mechanical systems. The approach is applicable even when the open- 
loop system has no inherent damping. The results are then applied to some common models 
of flexible joint robots and flexible beams. 
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The basic controller structure is the sum of a model-based feedforward and a model- 
independent feedback. The feedforward is chosen to form an error equation so that the 
ensuing steps for feedback stabilization can be applied: 

• Choose a static feedback so that the system is passive, stabilizable and detectable with 
respect to a particular input/output pair (usually corresponding to the force/torque 
inputs and velocity measurements of the degrees of freedom that are actuated). 

• Choose a strictly passive feedback between the passive input/output pair. From the 
Passivity Theorem, the closed-loop system is input/output stable. 

• If the feedback is chosen to preserve stabilizability and detectability, the internal states 
are also asymptotically stable. 

Passivity property for flexible jointed robot was recognized in [3] and indeed was used 
in a PD-type controller design. The method requires inherent damping in both joints and 
motors. Similar results without requiring the inherent damping has recently appeared in [4]. 
The result on PD stabilization of flexible beams was first shown in [5]. Our approach was 
independently conceived and contains a number of unique features as summarized below: 

1. Both flexible joint robots and flexible beam are considered as special cases of a more 
general framework of under-actuated Hamiltonian systems with elastic coupling be- 
tween actuated and un-actuated degrees of freedom. 

2. Any passive feedback is allowed without affecting stability. Examples have shown that 
higher order feedback (in contrast to the usual proportional-derivative (PD)) can lead 

' ' significant improved performance. 

3. Generalization to tracking control has been addressed from various perspectives. 

There has been many published work on applying exact linearization for the control of 
flexible robots, for a summary see [6]. In general, this approach requires the exact model 
information, linear spring assumption, and zero gyroscopic force coupling. Furthermore, the 
feedforward compensation (for linearization) and the feedback stabilization are intertwined 
and errors in the feedforward may affect the closed loop stability in an adverse way. In 
contrast, our approach requires much less model information in the set point control case 
(only the spring characteristics is needed), can be extended to the nonlinear spring case 
and fully coupled dynamic model, and the additive separation between the feedback and 
feedforward implies that error in feedforward does not lead to instability. The price to pay 
is that the closed loop performance cannot be arbitrarily assigned. 

For flexible beams (and more generally, flexible structures), the importance of passivity 
was well recognized in [7]. But only the set point control was considered and the uniform 
damping for flexible modes was assumed. There was also some work involving open-loop, 
computed torque type of control [8, 9]. We drew from this work for the construction of 
the feedforward trajectory for the error system. A general passive controller design for fully 
actuated arms was proposed in [10] which is later applied to a multiple-flexible-link robot 
in [11]. The method here is similar to this approach, but no inherent damping is required as 
in [11]. 
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The rest of the paper is organized as follows. Some background results that will be used 
in the stability analysis are collected in Section 2. The main procedure is outlined in Section 
3. Three application examples, flexible joint robots, flexible beam, and fully actuated robot, 
are then considered in Sections 4, 5, 6, respectively. Generalization to the trajectory tracking 
problem is considered in Section 7. Simulation results involving a single flexible joint robot 
are summarized in Section 9. 


2 Preliminaries 

The time evolution of ‘energy’ is an important and useful characterization of stability for 
physical systems, linear and nonlinear alike. Energy based stability analysis has been widely 
applied to the study of systems such as electrical networks, mechanical structures, thermal 
systems, etc [12]. The concept of passivity is traditionally defined as an input/output (I/O) 
•condition [13] describing a common class of physical systems which do not generate energy. 
Relationship between I/O passivity and state space parameters was extensively explored in 
the 60’s [14] in part by using the Lyapunov’s method. In this section, we will summarize 
some basic definition and results that will be useful for the rest of the paper. 

Define the input and output signal spaces, U e , y e , respectively, as extended spaces 
-L2e(R+ 5 R m ). Let P? denote the operator which truncates a signal at time T . Define 
the truncated inner product by 

( U (.),v(.)) T £ (P T u(.),P T v(.)) 2 = r(P T u(t)) T P T v(t)dt. 

«/ 0 

By a dynamical system, we mean an I/O mapping H : U e — ► 34- The input-output stability 
considered here is the finite-gain I/O stability. A system H is said to be finite-gain I/O 
stable if there exists a constant k such that 

||/Vy|| < k ||P T u|| for all T > 0. 

H is passive if 

( y,u) T > 0 for all T > 0. 

The concept of passivity can be generalized to dissipativity [15]. A system H is dissipative 
with respect to the triple (Q,S, R) if 

( y , Qy) T + 2 (y, Sv) T + (u, Ru) T > 0 

for all T > 0 and u €U e , where Q , 5 and R are memoryless bounded operators with Q and 
R self-adjoint. Clearly, a finite-gain stable system is dissipative with respect to (—I,0,k 2 I), 
while a passive system is dissipative with respect to (0,|/,0). 

An important theorem which can be used to determine the I/O stability of the intercon- 
nection of passive systems is the Passivity Theorem. In its simplest form, it states that if the 
open-loop system is passive and the feedback system is strictly passive, then the closed-loop 
system is Z^-stable i.e. finite-gain I/O stable. 

I/O stability infers internal state space asymptotic stability if the closed-loop system is 
stabilizable and zero-state detectable (if these properties hold globally, the internal stability 

Of rcoH Q-'-’/^rr 
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is also global). A system H is said to be zero-state detectable if u(t) = 0 and y(t) — *■ 0 
imply that the state x(i) — ► 0. For linear systems, this corresponds to detectabiUty. Under 
the stabilizability and detectability conditions, a dissipative system with Q < 0, i.e. a finite 
gain I/O stable system, has an asymptotically stable equilibrium at zero. 


3 Main procedure 

The class of systems considered in this paper is described by the following dynamical equation 
of motion: 

M(9)9 + D{9) + C(9,9)9 + f(9) = Bu (1) 

where 9 € R n is the displacement vector, u € R m is the input force vector, M is the 
mass-inertia matrix, D is the viscous damping and Coulomb friction, C corresponds to the 
centrifugal and coriolis forces, and / contains the gravity force, spring coupling force, etc. 
Note that for space applications, the gravity force can be ignored. 

Most mechanical systems belong to this class; additional assumptions will be imposed 
later as required. Particular systems of interest that can be considered include fully actuated 
robots, flexible joint robots, robots with flexible links, and satellites with flexible appendages. 
For the general discussion, we assume zero damping, i.e., D(9) = 0. All the results axe of 
course valid for the damped case also. 

We will first consider the output set point control problem. 

Assume the measured outputs are B T 9 and B T 9, i.e., the generalized coordinate and velocity 
that are directly actuated. Suppose the output of interest is 

y = CO. (2) 

Choose a feedback control law u based on the measured output, so that y(t) asymp- 
totically converges to the desired output set point y de3 . 

Based on the inherent passivity property of this class of systems, the general procedure 
described below can be used to construct a solution to the output set point control problem. 
Extension to output tracking will be addressed in Section 7. 

1. Steady State Analysis. The first step is to find a desired state 9 des and a feedforward 
irgrsuch that 


C9 de , = y de3 (3) 

Bug = /(«,..). (4) 

If these equations are solvable, then the feedforward control can be used to form the 
error system: 

M(9)9 + D(9) + C{9, 9)9 + f(9) - f(9 des ) = Bu 0 
where u = u 0 + ug. 


4 



2. Error system Stabilization. Assume that with a static feedback u 0 = g(B T 9), 
the map from u 0 to B T 9 is passive (this assumption will be justified for a number of 
applications). Then any strictly passive map from B T $ to u 0 can be used to feedback 
I/O stabilize the error system. If the closed loop system is further stabilizable and 
zero-state detectable with respect to u 0 and B T 9, respectively, then the zero error 
state is asymptotically stable. 

We will focus on three examples, flexible joint robots, flexible beams, and fully actuated 
robots, to demonstrate the application of the above simple approach. 

Remarks: 

1. If the system is linear, then the passivity of the original system (between u and B T 9) 
implies the passivity of the error system (between u 0 and B T 9). For nonlinear systems, 
additional assumption on / needs to be placed, for example, the joint stiffness is 
sufficiently strong relative to the gravity load for flexible joint robots. 

2. It is well known that passive linear systems are necessarily minimum phase and, con- 
versely, a minimum phase plant can be rendered passive through a static state feedback. 
A similar relationship for nonlinear systems has also been recently published [16]. It 
is shown that a nonlinear system can be rendered passive by static feedback (i.e., it is 
feedback equivalent to a passive system) if and only if the zero-dynamics are weakly- 
minimum phase and the relative degree is one. It is known that flexible joint robots 
and flexible beams have stable zero-dynamics with respect to the motor velocity and 
hub velocity, respectively. We will show that the static position feedback renders these 
systems passive. 

3. The classical proportional-derivative (PD) control law (for the actuated variable) is 
a special case of the family of control laws developed here. However, the velocity 
feedback can be augmented by any passive system in parallel. Through an example, 
we will see that the dynamic nature of the passive system can be exploited to enhance 
the closed-loop performance. 

4. As it will be shown in the application examples in sections to follow, the above analysis 
does not require any structural damping in the model. Damping, however, will be useful 
in the output tracking problem. 

4 Application to Flexible Joint Robots 

Consider the general model for an n-link flexible joint robot (2 n degrees of freedom) [17], 
This model contains the gyroscopic forces that are commonly assumed approximately zero 
[18, 19, 20]. Denote the link angle vector by 9( and motor angle vector by 9 m . Define 
9 = J 9 ( T 0 m T ] r . The dynamic equation of motion is given by 

.\[{9)9 + C{9 .9)9 + g{9) + k(9) = Bu (5) 



where B is of the form [ 0 I ] T due to the assumption that only motor shafts are actuated, 
g(0 ) denotes the gravity load, and k{9) denotes the spring coupling between motor shafts 
and the link shafts. 


4.1 Feedforward Compensation based on Steady State Analysis 

The control objective is to steer &t to some desired constant (i.e., in (2), y = 9 t ). The 
first step is to form an error system: 

M{9)9 + C{9, 9)9 + g(9) - g{9 dea ) + k{9) - k(9 dea ) = Bu - g{9 dea ) - k{9 dca ). (6) 


In order to cancel the additional terms on the right hand side, we need to find a feedforward 
torque ug and a desired set of angles 9 dea (as in (3)-(4)) that satisfy 

u = u 0 + uff (7) 

Buff = g{9 dea ) + k(9 dea ). (8) 


Equation (8) can be restated as follows: for a given 9t dc , , find 9 mdts and ugrsuch that 


0 = B(g(9 dea ) + k(9 dea )) (9) 

Uff = | + + k^,)) (10) 

where B is the annihilator matrix for B, i.e., BB = 0 ox B = \ I Ol. The terms 
and k(9 dea ) axe usually in the form 


9{0d*») = 

k(9 dea ) = 


9\{8i iea ) 

0 

Nk\(9t iea ,9 mdet ) 

—ki(9( dai ,9 m<Ut ) 


( 11 ) 

( 12 ) 


This implies that u ^ and 9 m<Ut should satisfy 


u ff 


N 

ffl(^es) 

N 


(13) 

(14) 


To solve (14), we assume that for a given 9i itl , (0t dei ,0 m ) is invertible in some open set 

in 9 m . Then by the Implicit Function Theorem [21], there exists a locally unique solution 
9 mdmi to the equation (14). A common form of k x is 


(k 1 )i(e ly 9 m ) = f(N i e t ,-9 mi ) 

where Ni is the gear ratio of the ith joint and / is monotonically increasing, continuously 
differentiable, and the range of / is R. In that case, since / is globally invertible, a unique 
solution, 9 mdei , to (14) can be found for any 9t ies . 
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4.1.1 Passivity 

With the desired motor angle and feedforward torque chosen as in (13) and (14), the equation 
of motion becomes 

M(9)9 + C{9 , 9)9 + g{9) - g{9 des ) + k{9) - k(9 de3 ) = Bu 0 . (15) 

If the sum of the gravitational potential energy and spring potential energy is positive 
semidefinite in A 9, A 9 = 9- 9 de „ then one can show that the map from u Q to 9 is passive. 
This is not true in general since 9 (dei can be arbitrarily chosen. Therefore, we introduce an 
artificial potential energy by using a proportional feedback; more specifically, choose u a to 
be 

u 0 = Ul - I< P B T A9. (16) 

Assume that it is possible to choose K p so that for some <5 > 0 

V e g(9 dea ) + V d k(9 des ) + BI< p B t > SI > 0. (17) 

Consider g{9) and k(9) as modeled by (11) and (12), respectively, where k x is 

k x {9 t ,9 m ) = f{N9 t -9 m ) (18) 

f is a monotonically increasing function and N is a diagonal matrix containing the gear 
ratios. Then condition (17) becomes 


f Vo t gi(0 td , M ) 0 

1 

' N 2 Vf(N9 (dt , - 9 md J -NVf{N9 tdt , - 9 m<Ut ) ' 

+ 

' 0 0 

[ 0 oj 

+ 

_ -NVf(N9 (det - 9 md J Vf(N9 idtt - 9 md J 

J 

0 K p 


If the spring at the joint is sufficiently stiff in the sense that 

N 2 Vf(N9 lde) - 9 md J > ( 2 °) 

then condition (19) is satisfied for a sufficiently large K p . 

Now consider the following scalar function 

V(A 9,9) = -9 t M{9)9 + U{A9 ) 

£ 

where the first term on the right hand side is the kinetic energy and the second term is the 
sum of the potential energies: 

U{A9) = G{A9 + 9 de3 ) - G(9 de3 ) - g(9 de3 ) T A9 + K{&9 + 9 des ) - K{9 de3 ) 

-k{9 de3 ) T A9 + l -A9 T BK p B T A9 (21) 

where G and I< are the gravitational and spring potential energies, respectively. Under the 
assumption that (17) is satisfied, U(A9) is positive definite. The derivative of V along the 
solution of the equation of motion, denoted by V, is 

V = 9 t Bu x (22) 

where we have used the fact that C{9,9 ) can be chosen (only C(9,9)9 is unique, but C{9,9) 
is not) so that |iV/ — C(9,9) is skew symmetric (a fact that was used in (2, 22, 23, 24, 25] and 
many others). Integrating both sides of (22) and using the fact that V is positive definite, 
it follows that the map from u x to B T 9 = 9 m is passive. 
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4.1.2 Stabilization 

Once the passivity from ti x to B T 0 is established, a large family of feedback control law can 
be used to achieve I/O stability: 


ui =u 2 - C v (B T 0) (23) 

where C v is any strictly passive system. Since the closed-loop system is the feedback connec- 
tion of a passive system and a strictly passive system, by the Passivity Theorem, the map 
from tt 2 to B T 0 is Testable. Furthermore, if u 2 = 0, we can conclude from (22) and the 
Invariance Principle that (6,0) converges to the largest invariant set in {(0,9) : B r 0 — 0}. 
To see this, recall that the strict passivity of C v means 

f w T C v (w) dt > —7 2 + tj f ||u7|| 2 dt. (24) 

Jo Jo 

for any w 6 L 2t . Substituting B T 0 into w, and noting that the left hand side of (24) asymp- 
totically vanishes due to (22), it follows that B T 0 € L 2 . Now by applying the standard 
argument that 0 are uniformly bounded, we can conclude B T 9 —* 0 asymptotically. Fur- 
thermore, since all higher derivatives of 0 are uniformly bounded, all higher derivatives of 
B T 0 also tend to zero asymptotically. If the closed loop system is zero state detectable from 
B T 0, then the zero error state is asymptotically stable. If the detectability is global, then so 
'' is the asymptotic stability. 

Under the following assumptions (slight generalization of the conditions in [4] and in- 
cluding the approximate model in [18] as a special case), the zero state detectability can be 
shown: 


1. The mass matrix M is of the special form 

M n (0t) M l2 (0 t 
M n T (0t) M 22 J ' 

This assumption is valid when the motor is symmetric about its axis of rotation; 
otherwise, all four blocks would depend on both Of and 0 m [26]. 

2. The gravity load g and elastic coupling k are given by (11) and (12). 

3. k is diagonal (i.e., k, only depends on 0 (i and 0 mi ). 

4. V 9t k(0 e , 0 m ) is positive semi-definite for all 0 ( and 0 m , and (0 e , 0 m ) for which V g ( k(0 t , 0 m ) 
loses rank are discrete. 

To see how this set of assumptions lead to detectability, substitute 0 m = 0 into the dynamical 
equation (1), then we have 

+ (25) 

= kM,e„)-kM^,9 m ^)-K r Ae m . (26) 
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(27) 


Differentiate (26) once more, we have 

" + Mn T Vt)6[ m VtM e,,9„)6 t . 

i= 1 

It has been independently pointed out in [26] and [4] (the former is for the exact case) that 
M \2 is strictly upper triangular. Applying this fact and assumptions 3 and 4 to (27), it 
follows that 9 ( = 0. Substituting back into (15), we obtain 

g(6) - g(6 de3 ) + k(9) - k(9 de3 ) + BK P B T A9 = 0. (28) 

From the assumption that K p has been chosen sufficiently large as in (17), (28) implies local 
asymptotic stability. If (17) holds uniformly for all 9 des , then the asymptotic stability is in 
fact global. 

For the general model, the observability condition can be checked for the linearized 
system. First set u 2 {t) = 0 and B T 9(t ) = B T 9(t) = 0. From linearized closed-loop equation 
of motion, we have 

B T M(9 de3 )~ 1 (V 9 g(9 de3 ) + V B k(9 de3 ) + BI< p B T )/\9 = B T M(9 de3 )~ 1 1< A9 = 0. 

Differentiating this equation twice more and use the equation of motion again, we have 

B T M(9 de3 )~ 1 K9 = 0 
B T M{9 de3 )- 1 kM(9 de3 )~ l KA9 = 0. 

These equations together imply the full state is identically zero if and only if M(9 des ) - I< 

is nonsingular, where K = ^eQiPdea) + ^eK^des) + BK P B T . 

From the above analysis, it is clear that under fairly mild conditions, the zero error state 
of the closed-loop system is globally asymptotic stable. But which C v should one choose 
among the many possibilities in order to enhance a specified performance measure? This 
appears to be a hard question in general. We shall again encounter the same question in the 
next section. At the present, we do have some intuitive rules of thumb for the selection of C„. 
The simplest choice of C v would be just a constant gain. Then the closed-loop control law is 
of the PD type (but only the motor variables are fed back). As demonstrated in simulation 
in [27], in contrast to the fully actuated robots, large PD gains degrade the closed-loop 
performance in terms of the settling time and amplitude of oscillation. This is due to the 
fact that the zeros in the Ux to 9 m system are on the jw-axis, high gains would then drive 
some of the poles toward these zeros and the response would become increasingly oscillatory. 
It is intuitively plausible to choose C v to be an SPR (i.e., linear time invariant and strictly 
passive) compensator where the gain is concentrated at the open-loop resonant frequencies 
(so that a small oscillation in 9 m will cause a large corrective action) and at the disturbance 
frequencies (as in notch filters). In simulation [27], much improvement is obtained by using 
this approach. This idea is similar to a common practice in servo control where a band 
pass or high pass filter is used in the motor velocity loop (usually analog), in addition to 
the usual PID loop, to improve performance in the higher frequency range (for example, see 
the servo controller for space shuttle remote manipulator system in [28]). For the type of 
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systems considered here, we can be more specific about the class of filters that can be tuned 
for increased performance without affecting the stability. 

In the feedforward, the only model-dependent information that is required is the grav- 
ity load and spring coupling. If this information is inexact, then u 2 in (23) is a nonzero 
constant. Since local internal asymptotic stability implies bounded-input/bounded-output 
(BIBO) stability for sufficiently small initial error, the output error 9 ( — 9 (dta is also pro- 
portionally bounded, and the internal states would remain bounded. In Section 8, we will 
adaptively update this constant; not surprisingly, the resulting control law is of the standard 
proportional-integral-derivative (PID) structure. 

In the case that the full state is available, an interesting question arises: How can 9( and 
be included in this passive control framework? A reasonable approach would be to find 
another output which is independent from 9 m and passive with respect to u 2 (i.e., after the 
A 9 m and 9 m loops have been closed as described above). Then an additional strictly passive 
feedback can be applied to enhance transient performance. Finding an additional passive 
output for a linear system of the form x = Ax + Bu is straightforward: solve the Lyapunov 
Equation A T P + PA + Q for some Q > 0, then choose the output map to be C = B T P. A 
general procedure for nonlinear systems such as the flexible joint robots is unknown at the 
present. 


4.1.3 A Simplified Dynamical Model 

The exact model for flexibly jointed robots is not exact linearizable [29]. In [18], a simplified 
model for flexibly jointed robots was proposed. This model ignores the gyroscopic forces due 
the motion of rotating motors in the inertial space. Based on this model, an exact linearizing 
control law was obtained. The simplified and full models have been compared in [17] based 
on the parameters of a PUMA 560 robot and it is concluded that the approximate model is 
a very good one for earth bound applications (when the arm is mounted on a mobile base, 
the effect is far more drastic). The space shuttle remote manipulator system is also modeled 
under this assumption [28]. In this subsection, we consider the stability analysis and control 
design discussed above as applied to this simplified model. 

The simplified model is of the form 

M 1 (0 ( )9 ( + C l (9 t j')9 t + g 1 (9') + Nk 1 (N9t-9 m ) = 0 (29) 

I m 9m - k l (N9 e - 9 m ) = u. (30) 


Given the desired link angle vector 9( dea , the steps in section 4.1 can be followed to obtain 
the feedforward control u and desired motor angle vector 9 mdea for the error system: 


u ff 


9 


771 dcs 


N 

N9 tdda - *f l ( 


N ’ 


(31) 

(32) 


where k x is assumed to be globally invertible. The spring model for k x is usually assumed 
to be diagonal (i.e., the ith component of &i(z) only depends on x,) and each component 
is monotonicallv increasing. Hence, the invertibility assumption on k x is a very reasonable 
one. 
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The error system is described by 

Mi{9()9 ( + Ci(8{, 8()8( + <7i(0*) — 9\{8e dt3 ) 

_ +Nk l (N9 l -e m )~ Nki(N6 la " - 6 md J = 0 (33) 

Im 8 m — h{N8 t — 8 m ) + k\(N8t ica — 8 mde3 ) = u 0 (34) 

where u = u 0 + ug has been used. As in section 4.1.1, in order to show passivity, we introduce 
a proportional feedback to create a positive definite potential energy at the desired set point: 


u 0 = u 1 - I< p A8 m . 


Now, assume 


VtfiPO + N^MN9 ldta - 8 md J -NVehiNd^, - 8 md J 
-NV d h{N8 ldat - 8 md J K p + Veh{N6 tda , - 8 md J 


> 0. 


(35) 


This condition is satisfied if the spring is sufficiently stiff compared to the gravity load 
(typically a reasonable assumption especially for geared robots) and K p is sufficiently large 
in the following sense: 


N*VMN8i«. - 


(36) 


. . (K w w jjy^Mjvg^ 

^minl Ap) > 7 T 

With the storage function 


s de j ))• (37) 


V = \j), T + U( A0 (> A0„) 


(38) 


where 


U(A6,,A0 m ) = G,(A«, + «<„,) -G, («,„.) - Sl (9, a J T A0, 

+l<t{NA0 l - A0 m + N^, - «„„.) - - «„„,) 

-k,(Ne ti „ - e mi j T (NAe, - a«„) + ^A 0 jK r Ae m . (39) 

The scalar functions K\ and G\ are the spring potential energy and gravity potential energy, 
respectively. Again use the skew symmetric property of \Mi — C\\ it follows that the 
derivative of V along the solution trajectory of (29)-(30) is 

v = dju, 

which implies that the map from Uj to 8 m is passive. 

The final step is to choose a motor velocity feedback for stabilization. Again by the 
Passivity Theorem, u 2 can be chosen as 

ui = u 2 - C v (8 m ) 

where C„ is strictly passive, the closed-loop system is L 2 I/O stable from u 2 to 8 m . 

Since the simplified model in this section satisfies all the assumptions stated in the last 
section, global asymptotic stability of the zero error equilibrium follows from the I/O stabil- 
ity. 
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5 Application to a Single Flexible Link 


Consider the linearized model for a single link flexible link [30, 31] discretized in terms of 
the natural modes: 

q + f l 2 q = bu (40) 

where q is the modal amplitude, u is the hub torque, and 


n 2 


Olxl Oixn 
.0 nxi diag 

nxnl^i 1 -I 


i r = -[V>o(0) xi>[{0) 

p 


«(0)] 


where p is the link density (over unit length), w,’s are the natural modal frequencies and 
^,-’s are the corresponding mode shapes. Spatial derivatives are denoted by ' . Here we 
consider only an (n + l)-mode approximation to avoid the technicality associated with 
infinite dimensional systems. For a discussion in the infinite dimensional context, see [31]. 
Note also that the nonlinear model in [31] is of the same form as (6) in the flexible joint robot 
case. The same analysis as in the previous section can be applied. Here we will concentrate 
on the linearized model. 

Let x = [9, q] T . The state space equation is 


x = 


0 I 

-n 2 0 


X + 


0 

6 


u. 


(41) 


Assume that the hub angle and angular velocity can be measured. The corresponding output 
equations are 


(42) 

(43) 

where y v and y v are proportional to the hub angular position and velocity, respectively. 


y p = [b T 0]x 
y v = [0 b T ]x 


5.1 Feedforward Compensation based on Steady State Analysis 

Suppose the output of interest is the scalar variable 

V = Cq. 

Consider the set point control problem of steering an arbitrary initial state {q(0),q(Q)) to 
a steady state which corresponds to a specified desired output ydes- As in (3)-(4), we are 
interested in finding a full state set point qd ca which maps to the desired output i /d C5 , and a 
feedforward u ^that cancels the extra terms in the error dynamical equation for A<? = q — qdcs- 
This means qd es and u g must satisfy the following equations: 

^ qdcs ^ ff 

Cqdcs — 
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ydcs • 


(44) 

(45) 


Assume the leading components in b and C, bo and Co, respectively, are nonzero. Then the 
model matching equations (44)-(45) imply 


Uff = 0 

Vdts 

0 — “ 

A) 

qdesi = 0 for i > 1. 


The error equation is then governed by 


q + £l 2 Aq = bu 

Aj/p = b T Aq 


(46) 

(47) 

(48) 


(49) 

(50) 


where A q = q — qdes ■ 

5.2 Passivity 

In the error dynamical equation, ft 2 is only positive semidefinite. For internal stability, cf. 
section 5.3 below, it is important that the stiffness matrix is positive definite. To achieve 
this, a proportional feedback loop is first closed: 

u — ui — kplF Aq. (51) 

The effective closed-loop stiffness matrix is then 

Q 2 = n 2 + k p bb T . 

Since it is assumed that bo ^ 0, fl 2 is positive definite for any k p > 0. 

To show the mapping ui to b T q is passive, consider the storage function 

v(i) = l||9l| 5 + l/n ! ? . 

It is easily verified that the derivative of V along the solution is V = (b T q) T ui. The passivity 
from Hi to b T q follows from the fact that V is a positive function. 


5.3 Stabilization 

For the open-loop error system (49), the controllability matrix, after reordering the columns, 

i3 c = f° C °1 

ICo oj 

with 

Co = [b -n 2 6 fi 4 6 ... (-fi 2 r&]. 

Assume the modal frequencies are all distinct and every component of b is nonzero, then Co 
is invertible which means that the system is controllable. 
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The observability matrix with respect to y v for the open-loop error system is 

ro - n 2 c 0 1 

LCo o . • 

Since ft 2 is singular, O is singular which means that the system is not observable from 
y v . However, with the proportional feedback of the motor position as in (51), Cl 2 in the 
observability matrix is replaced 

Cl 2 = Q 2 + k p bb T 

Since Cl 2 is nonsingular, the observability matrix is also nonsingular and the system is ob- 
servable. 

By the Passivity Theorem, the hub velocity loop can be closed with any strictly passive 
feedback C v , i.e., 

m =u 2 - C v (b T q), 

and the resulting closed-loop system is Z 2 -stable from u 2 to b T q. For the internal asymptotic 
stability, we need stabilizability and detectability. From the analysis above, it is evident 
that if the poles of C v do not cancel with the zeros of the system with proportional feedback, 
then the overall closed-loop system is controllable and observable, and, therefore, internally 
asymptotically stable. 

It is tempting to choose C v to be an SPR filter which, over certain bandwidth, approxi- 
mates the plant inverse (this is possible since the plant is passive, therefore, minimum phase). 
Then the 1/ O map from u 2 to b T q is approximately constant in that frequency range. This 
would result in an excellent I/O response; however, the internal state becomes almost un- 
observable which means a very poor internal state response. This has indeed been observed 
experimentally, where excellent step response is obtained at the hub but the beam oscillates 
at a frequency corresponding to the pair of zeros with the lowest frequency. 


6 Application to Fully Actuated Robots 

The passivity property of fully actuated robots has been much exploited in recent years, 
starting from the path breaking work in [2] to many later extensions in, for example, [22, 23, 
24, 32] and many others. This section briefly reviews some of these results and shows how 
they fit into the framework outlined in Section 3. 

The equation of motion for a fully actuated arm is the same as that for the flexible joint 
robot (5) except for B = I and k = 0: 

M (0)0 + C(0, 0)0 + g(9) — u. (52) 

Consider the set point control problem, i.e., the control objective is to steer an arbitrary 
initial condition (0(0), 0(0)) to a specified set point (0^,0). 

The first step is to choose a feedforward control to form the error system 

U= U 0 + Ufj f 
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where ujj may either be the gravity load cancellation or the gravity load at the desired set 
point: 


u ff = 9(9 d's) Or (53) 

u ff = g{9). (54) 

In both cases, a position feedback loop needs to be closed to ensure a positive definite 
stiffness: 

u 0 -u x - I\ P A9 

where K p is positive definite. In the first case, K p should be chosen large enough so that 
the combination with the gravity potential energy is positive definite. To show the passivity 
from u x to 9, the following storage function can be used: 

V{6, 9) = i 9 t M{9)9 + U(A9) (55) 

where U is the total potential energy (including the position feedback loop) 

U(A9) = ±A9 t K p A6 + G(A9 + 9 dea ) - G{0 de3 ) - g(9 de ,) T A9 for (53) 

U(A9) = i A9 t I< p A9 . for (54) 

Now, any strictly passive feedback from 9 to Uj can be used: 

u x = u 2 — C v {9). 

By the Passivity Theorem, the closed-loop is /^-stable from u 2 to 9. Since the stiffness 
term is globally positive definite, 9 is globally zero state detectable. With only the position 
feedback loop, the system is globally controllable (since u can always be chosen as an exact 
linearizing controller). If the velocity loop is exponentially stable, then the stabilizability is 
preserved, hence the zero equilibrium of the error system is globally asymptotically stable. 

7 Tracking Control Problem 

So far we have considered only the set point control problem. Another important aspect of 
the control design is the output trajectory tracking problem. An intuitive approach is to 
simply replace 9 by A 9 in the set point controller with the hope that a well tuned set point 
controller would also imply good tracking. In this section, we will both justify and modify 
this intuitive approach. 

Given the general dynamical equation (1), consider the problem of finding a feedback 
control u so that the output y — C9 tracks an arbitrary trajectory y des asymptotically. A 
natural extension of the set point control approach presented before is to express the system 
dynamics in the error coordinate and choose a feedforward control ug to cancel the extra 
terms in the dynamics, assuming that this is possible: 

M(9)A9 + C(9, 9)A9 + f{9) - f{9 des ) = Bu 0 (56) 
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where u = u 0 + u g has been used and 

Bug = M{9)9 de , + C{9, 9)9 de3 + f(9 des ) (57) 

is assumed to have a solution, given y de3 {t) = C^ ej (i), * > 0 (this issue is discussed in greater 
detail in Section 7.0.4). Note that in contrast to the set point control case, not only is the 
model information required in the feedforward but, in general, the full state measurements 
as well. 

An important extension of (57) is to add to 9 de3 with an error feedback, £(A 9, A 9) (assume 
the equation is solvable). Then the feedforward to be solved is 

Bug= M(9)(9 det - t(A 9, A0)) + C(9,9)9 de , + f{0 de3 ). (58) 

The solvability of this equation in the flexible joint robot case is discussed in section 7.0.4. 
The error equation with this feedforward becomes 

M(9)A9 + M{9)£{ A9, A 9) + C(9, 9)A9 + f(9) - f{9 de3 ) = Bu 0 . (59) 

The additional term l can now be chosen to augment performance (this is especially effective 
if M strongly couples different degrees of freedom). 

Next close a position loop: 

u 0 = ui — K P B T A9 

where it is assumed that K p can be chosen sufficiently large so that BK P B T + V s f(9 de3 ) > 0 
(same as the set point case). The problem is that f(0 de3 ) is now time varying and, conse- 
quently, the passivity property from ui to A 9 cannot be easily shown as before (an exception 
is when f is linear, a fact we shall use in section 7.0.2). There are three approaches to this 
issue: 

1. The only time varying term in the error system is due to 9 des . For each fixed time, the 
same passivity analysis as before can be applied to show local asymptotic stability. By 
applying a well known theorem for time varying systems [33], closed loop asymptotic 
stability is preserved if 9 dea is sufficiently slow time varying. 

2. If the feedforward torque, ug , is chosen to compensate for g(9) rather than for g{9 des ), 
provided that it is solvable, then the passivity analysis can again be applied. 

3. Define a new output z = B T 9 + gB T 9 where g is a small positive parameter. If B = I 
(full actuation case) or there is inherent structural damping D such that D + BI< V B T is 
positive definite for some I< v > 0, then the map from «i to 2 is passive for g sufficiently 
small, and the same passivity analysis can be applied. 

In the remainder of this section, we will elaborate on each of these approaches, and also 
discuss in detail the solution of the feedforward torque. 
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7.0.1 Tracking for Slowly Varying Trajectories 

To apply the stability result for slowly time varying systems, the feedforward in (57) needs 
to be slightly modified to 

Bu ff = M{9)9 dea + C{9,9)9 dea + C{9,9 dea )A9 + f{0 dea ). (60) 

Then the error equation becomes 

M{9)A9 + C{9 , A9)A9 + f{9) - f(9 dea ) = Bu 0 . (61) 

In (61), the only time varying quantities are 9 dea and 9 dea . If they are “frozen” at a particular 
constant value (i 9 de J dea ) = ( 0 dea (T),9 dea (T )) where T > 0 is a constant, then the derivative 

of the following scalar function 

V(A9,AQ) = ^A9 T M{A9+9 dea )A9 + U(A9+9 dea )-A9 T f(9 dea )-U{9 dea ) + -A9 T BI\ p B AO 

is V = A9 t B u i, where U is the potential energy corresponding to / and BI\ P B T + 'V$f(9 dea ) 
is assumed to be positive definite uniformly in 9 dea . Hence, the stabilizing control law design 
based on the passivity approach as described in the previous sections (with 9 replaced by 
AO) stabilizes all frozen systems. Under the additional assumption that the frozen systems 
are locally uniformly (with respect to T) exponentially stable, a Theorem on slowly time 
varying systems as stated in [33, Theorem 5.6.6] can be applied to show local exponential 
stability of the closed loop system provided sup, max {d des (t),d dea {t)] is sufficiently small. 
Simulations in [27] confirm this result, where a slowly time varying sinusoid can be closely 
tracked, but not a fast time varying sinusoid. 


7.0.2 Tracking by Direct Compensation 

Another possibility is to directly compensate for part of f{9) in (56). The feedforward torque 
that needs to be solved is now 

Bu ff = M{9)9 dea + C{9, 0)0 dea + f x {9) + F9 dea (62) 

where we have decomposed f{9) according to f{9) = fi{9) + FO where F is a square matrix. 
The reason that we decompose / in this fashion is related to the solvability of (62) (see 

section 7.0.4 for detail). 

Assume that a solution exists, then the error equation is of the form 

M{9)A9 + C(9, 9)A9 + FAO = Bu 0 . (63) 

Now the same passivity analysis as before can be applied for the control law 

u 0 = -K P B T A9 -C V {A9) (64) 


for any strictly passive C u . 



7.0.3 Tracking by Output Modification 

Even in the local version of (56), with f(9) - /(**,) replaced by V 0 f(Q des ) A0, V 0 f(e des ) + 
BKpB > 0 for some A p , the map from u 0 to B^ AO is still not passive in general. This can 
be seen by evaluating the L 2 innerproduct between this input/output pair: 

l ( B T A0) T u o dt = J* A0 T (M (0)A0 + C(0, 9)A0 -f V 9 f(6 de3 )A9) dt 
= \m T M{0)A0^ + ^&e T V e f(9 de3 )A0\ T o 

-\j Q T M T j t (V 9 f(e dea ))A6dt. ( 65 ) 

Smce 3 l i(^sf(0des)) may be sign indefinite, the integral cannot be bounded below by a 
constant. To counter the effect of this last term, we consider adding a proportional feedback, 
B T AO. The contribution to the input/output innerproduct due to this addition is 

jf ( B T A0) T u o dt = jf A0 T (M(0)A0 + C(0,0)A6 + V e f{O de ,)A0)dt 

= A0 T M(0)A0\ T Q - (A0 T M(0)A9 + A0 T (M(0,0) -C(0,O))A0)dt 

+ f o A0 T V 0 f(O des )AOdt . (66) 

For the local analysis, we shall ignore the higher order term ( M(0,O ) - C(Q,6)). Now, 

consider adding a static PD loop: 

u 0 = -K p B T A0 - I< v B t A9 + u x . (67) 

Then the innerproduct between and B T AO is the same as (65) except V e f(0 de3 ) is replaced 
by ^sfiOdea) + BK P B T and there is an additional term: 

F A9 t BK v B t AO dt. 

Jo 

The innerproduct between u x and B T AO are the same as (66) except V s f(O de3 ) is replaced 
by Vfl / (Odes) + BK p B t and there is an additional term: 

1 ao t bk v b t ao\ t q . 

Now form the augmented output 

2 = B t A0 + cB T AO. 

For c sufficiently small and 0 des sufficiently slowly time varying, all terms in z T (t)iii(t) dt 
can be bounded below by a constant except for the integral involving the quadratic term in 
AO which is 


Terms involving the error states at time T can be lumped together in a quadratic form: 


' A 9{T) ' 

T 

' f (V 9 f + BI< P B T ) 

cM ' 

' A 0(T) ' 

_ A 9{T) _ 


cM 

* 


_ A 9{T) _ 


Since M and V e f + BI\ P B T are both positive definite, for c sufficiently small, this term is 
positive. 

Only the indefinite term in (68) prevents the map from Uj to z from being passive. There 
are two situations in which this term is also bounded below by a constant: 

1. The arm is fully actuated, i.e., B = I. This approach is the same as in [34]. 

2. There is an inherent damping, D9, which gives rise to the term D/\9 in the error equa- 
tion (the feedforward ug needs to be modified accordingly). If D + BK V B T is positive 
definite, then for c sufficiently small, the integral is bounded below by a constant. 

If either of the above situation holds, then the map from to z is passive and the same 
analysis can be carried as before to generate stabilizing control laws based on passive map 
from z to ui. In the example in [27], it has been shown that link damping in a flexibly jointed 
robot allows tracking of a fast trajectory that could not be tracked when the damping is 
absent. 


7.0.4 Derivation of the Feedforward Compensation 
Flexible Joint Robot Case 

To form the tracking error dynamic equation, we need to solve for ug in either (57) or (62). 
In this section, we will consider this problem for the special cases of a flexible jointed robot 
and a single flexible link. 

We will consider only the simplified flexible joint model given in (29 )— (30) ; the general 

case is considerably more complicated. Suppose y = 9(. Then (57) involves solving for 

.(0) gi ven ®t de M) an d its higher time derivatives (as many as required) 

and (9 m (t),9 m (t),9i(t),9i(t)), from the following set of equations: 

Mi{9 ( )9e dea + Ci(6(,9()9 (dea + gi(9 (dea ) + Nk l (N9( dea — 9 mdta ) = 0 (69) 

Im9m dcs — k\(N9( dca — 9 mdaa ) = ug. (70) 

Assuming k x is strictly monotonically increasing so an inverse function k~ l exists. Assume 
ki is twice differentiable. Then 9 mdaa can be solved from (69): 

= m.., + + + », («<*,)!)• (n) 

To solve ug from (70), 9 mdca must first be computed. This can be done by differentiating 
(71) twice: 


d 2 




A Be ^ + dt 
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Note that the second term involves 8 ( and which can in turn be resolved using the 
dynamic equation (29) and its derivative. Finally, u^can be computed from (70). _ 

For the direct compensation case, cf. (62), the feedforward compensation equation based 
on the simplified flexible joint model is 

M x {9 t )8 tdt , + +9i(9t) 

+Nk 2 (N9 t - 9 m ) + NI<(N9 e<Ut - 9 m<t J = 0 (73) 

~ k 2 (N9 t - 9 m ) - K{N0 tie , - 9 md J = u ff (74) 

where K is any square invertible matrix and k 2 is chosen from k 2 (x) = k x (x) — I<x. Following 
similar steps as before, (73) can be used to solve for 9 mdtt : 

8 mdea = + C x (8 t , 6 t )6 tde , + g x {9 t ) + Nk 2 (N9 t - 9 n )) + N9 (dcs . (75) 

To solve for u ffixom (74), again 9 m<u , needs to be computed by directly twice differentiating ^ 

both sides of (75). However, 9 mdei now not only contains 9 t and 9 t which can be resolved 
using the dynamical equation and its derivative as before, but also 9 m (through the derivative 
of k 2 ) which in turn depends on ujj. Therefore, to solve we need the invertibility of __ 

(/ + K~ l ^7 x k 2 {x) ) for all 9 t and 9 m , which does not appear to be a severe limitation. 

Note that if the spring is assumed to be linear as common practiced in the literature, this 
additional assumption would not be needed. 

For flexible joint robots, Eq. (58) can be solved in exactly the same fashion as above. A 
simple but useful choice of the function l is simply _ 

£(A 9, A 9) = K Pt A9{ + K Vl A9 e (76) 

The closed loop equation is now of the following form 

Mi(9()A9( + C\(9i, 9()A9( + gi{9() — g\{9i dct ) _ 

+Nk l (N9 e - 9 m ) - Nh{N9 tdt , - 9 md J + M x (9 e )(K Vt A9 t + K Pt A9 ( ) = 0 (77) 

I m A9 m - k x {N9 t - 9 m ) + ki(N9 td€t - 9 md J + K Prn A9 m = u x (78) 

The system linearized about (A0,A<?) = (0,0) is passive between iq and A^ m since the 
stiffness matrix 

' V<q(0qj + N 2 Vk x (N9 tdt , - 9 md J + M x (9 td JK Pt -NVk^NO^ - 0 md J 

~NVk l (N6 (d ) J 

is positive definite. Hence, any strictly passive loop between A 9 m and iq can be closed to 
ensure closed loop asymptotic stability of the error system. 

The purpose of the feedforward control can be thought of as winding up the spring torque 
so that the link dynamics is governed by 

A 9( + I\ V( A9f + l\ Pt A9> — 0. 
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The role of the feedback control is to produce the motor trajectory that is required for this 
feedforward. 

Flexible Link Case 

For the flexible link case, the situation is quite different since the acceleration of the 
actuated degrees of freedom are not decoupled from the acceleration of the unactuated 
degrees of freedom as in the simplified model of a flexibly jointed robot. We now need to 
solve for (u jj, q de3 ) given a desired output trajectory y dea : 

qdes + = Buff (79) 

Cq dea = ydes ( 80 ) 

with the additional constraint that Ujj needs to be uniformly bounded for implementability. 
This problem is almost identical to the inverse plant problem considered by [35], but here we 
solve for the desired plant trajectory rather than the actual plant trajectory. Consequently, 
while the control law obtained in [35] is entirely open— loop, here we have a feedback control 
structure. 

To analyze the solution of (79)— (80), first express q dea in the following form: 

qdes = C + y de , + C( (81) 

where C + = C T ( CC T )~ 1 is the pseudo-inverse of C and C is the nx(n-m) full rank matrix 
that is annihilated by C ( CC = 0). Note that C can be formed by the linearly independent 
columns of (/ — C + C), but C ^ (I — C + C) since C is full rank. 

Differentiating the equation twice, we have 

qdes = c+y de3 + c£. 

Substitute back into (79) and assume B is full rank, we can solve for uff. 

u ff = ( B T B)~ 1 (£ T C + y de3 + B T Cl + B T n 2 (C+y dea + C£)). (82) 

To eliminate ujj from (79), we multiply B (the annihilator of B) from the left; and using 
(81), we have 

BCi + BQ 2 Ci = -B{C + y dea + Q. 2 C + y dea ). (83) 

If CB is invertible, then BC is also invertible and the dynamics of f is governed by 

l + = Lp (84) 

where p = [ y dea y des T ■ We shall assume that det (s 2 I + A) does not contain any purely 
imaginary roots. 

If CB is singular, then part of f can be determined algebraically, and the rest is governed 
by a dynamic equation of the same form as (84). For the ease of presentation, but without 
loss of generality, vve shall assume CB is invertible. 

For implementability, the initial condition, (<f(0), £(0)), needs to be chosen so that £ ( 0 
that solves (84) is uniformly bounded for all t. There are two equivalent approaches to find 


21 



the initial condition. A Laplace transform approach was stated in [35] and a time domain 
approach in [9]. We will discuss both approaches here. 

In the first approach, the Laplace transform of (84) is taken: 

i( S ) = ( s 2 i + a r x (Lp( S ) + *e(o) + e(o)). 

Suppose p(s) is analytic in the open right half plane and has only simple poles on the 
imaginary axis (i.e., yd e3 {t ) is uniformly bounded), then the terms in £(s) that can lead to 
unbounded time response are only those associated with the unstable roots of det(s 2 / + A). 
Since A is n — m x n — m, there can be at most n — m unstable roots. Correspondingly, 
there are n — m residue vectors (in R m ) which, when the contributions in are all set 
to zero, lead to m(n — m) equations. There are 2 (n — m) constants that we can choose in 
(f(0)>£(0))- Hence, if m = 2, an initial condition can be chosen in general to nullify the 
residues associated with the unstable poles. If m = 1, all residues can be nullified, implying 
the time response of £(t) is zero after some finite t. The requirement that m < 2 appears to 
be unnecessarily strong as will be evident from the time domain analysis below. 

An equivalent time domain approach can also be taken. First write (84) in the first order 
form: 


T 

J. 

= 

0 

-A 

O ^ 

j. 

+ 

i 1 

O 


After transforming the coordinate according to the stable and unstable eigenspaces (recall 
that the center subspace is assumed to be trivial), the system is partitioned as 


7+ 
7- . 


A + 

0 


0 

-A_ 



P 


where A + and A_ are both strictly unstable. The unstable response is given by 

7 •♦(<) = e A *' 7+ (0)+ f L+dr) dr 

Jo 

= e A+i (7 + (0 )+ f e -A+r Z,+p(r) dr) (85) 

Jo 

Choose 

roo 

7 +( 0 ) = - / e" A+r Z + p(r)dr (86) 

Jo 

assuming the integral exists (which is true if yde$ is uniformly bounded). Then 

/ oo 

e x+{t ~ T) L+p(r)dT 

= - f°° e~^ s L + p{t + s)ds. (87) 

Jo 

The uniform boundedness of 7 + follows from the strict stability of — A + : 

Il7 + (f)ll < jf «<-*• l|£j ML. d* = £ lli+ll ll/>ll t . 
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where — cr+ = max, ReA,( — A+), A,- denotes the eigenvalue, and M is some positive 
constant. In [35],* it was pointed out that the procedure of choosing the initial condition to 
guarantee the boundedness of ujj is highly sensitive numerically since any slight numerical 
error could lead to divergence. Eq. (87) shows that 7 '+(0 be stably computed even 

though A + is strictly unstable. Note that the condition on the number of input/output 
pairs is no longer required in this analysis. This discrepancy appears to be due to some 
relationship in the residues that we are not taking advantage of. 

As in the Laplace transform approach, 7.(0) can be chosen to achieve the zero steady 
state for 7- if / 0 °° e A - r T_/?(r) dr < 00. 

To illustrate the procedure described above, consider a simple example presented in [35]. 


1 

-1 ' 


1 

1 

-1 
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? = 

-3 j 
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0 

II 
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Follow the procedure outline before, qdcs can be represented as 


Qdea — 


0 

1 


Vdea "4* 


1 

0 




After substitution into the dynamic equation, u^can be solved: 

u ff~ g (” Vdea ~ tydea + 2f + 3£)- 
Substitute back into the dynamic equation for f , we obtain: 

{ - f = -ydea ~ ( 88 ) 


Suppose the desired output trajectory is given by 


[ 1 0 < t < 1 

y de . = < -1 i<*<2 

[ 0 t > 2. 


( 89 ) 


and y deJ (0) = ydes{ 0) = 0- For simplicity, make a change of variable t] — Vdest then 


rj — rj = -3 y des (90) 

ujj — — [2y + 3)7 + 3j)dea) (91) 


The Laplace transform of y^ea is 


tide »($) 


(1 — e ~*) 2 

s 


(-3s- 1 ! 1 -e- s ) 2 ~sm 0 ) + nm) 

7?(.S)(S) = —5 


Therefore, 



If only the unstable residue is to be canceled as suggested in [35], one choice for the initial 
condition is 

t?( 0) = i?(0) = |(1 - e" 1 ) 2 - (92) 


In this case, since m = 1, residues associated with both poles can in fact be canceled by 
choosing 

f((l ~ e -1 ) 2 + (1 — e) 2 ) 

- e-'? + (1 - ef) 

An equivalent time domain approach can also be taken. The solution of (88) is 


77(0) 


. *(°) . 



(93) 


cosh f 

sinh f 

( 

' 1 ( 0 ) ' 

2 r* cosh r — sinh r 

' 0 ' 

sinh f 

cosh f 

{ 

. ’>(°) . 

Jo — sinh r cosh r 

1 


77(f) = 

After using (89), the integral, for f > 2, is a constant: 


2 Ut 


,(r) dr). 


cosh r — sinh r 

’ 0 ‘ 

•• / \ 7 

1 — 2 cosh 1 + cosh 2 

— sinh r cosh r 

1 

UdesKT) dr = 

2 sinh 1 — sinh 2 


Since the stable eigenspace is spanned by 


1 

-1 


and the unstable eigenspace is spanned by 


, choosing the initial condition according to (92) leads to 


V(t) = -|c *(1 + e 2 ~2e) 

for t > 2 and choosing the initial condition according to (93) leads to 77(f) = 0 for f > 2. 
Clearly, the latter choice has the advantage that the feedforward control (cf. (91)) is no 
longer needed after the desired output trajectory has come to a rest. 

When the desired output is assumed generated from a reference model and the model and 
plant parameters satisfy a model matching condition, a solution of (79)-(80) can be more 
easily solved. This is called the regulator approach, a version of which, called the command 
generator tracker theory, was proposed in [7]. The nonlinear version can be found in [36], 
Application to the flexible arm control can be found in [37]. We present this approach for a 
general linear time invariant system. Consider 


x de3 = Ax de3 + Bujj 

l Idea = Cxj ej . 

The desired output y de3 is generated from a linear time invariant reference model: 

w = Sw 

Vdc, = Qw 


where w € RA We seek a solution of the form 


where F and a matrix P together should satisfy 


PS-AP = BF (95) 

CP = Q (96) 

which are called the model matching conditions. The initial condition xj ej (0) should be 
chosen as 

x«fe,(0) = Pw{0). (97) 

Clearly, if the exosystem is stable, the feedforward signal will be uniformly bounded. 

The model matching condition (95) can be written as a linear matrix equation by using 
Kronecker products [38]: 


' S T ® / - / <g> A 

I ® B 

'Pc' 


0 

I®C 

0 

. F c 


,Qc m 


(98) 


where the subscript c denotes the vector formed by stacking up the columns in the matrix. 
For a given plant and exosystem, the solvability of (98) can be readily checked (a sufficient 
condition is the invertibility of the matrix containing A, B, C, and 5), and if solvable, P 
and F can also be easily found. 

The feedforward ug given by the linear regulator approach is a particular solution of (82) 
from the plant inversion. It would be interesting to query if the initial condition chosen as in 
(97) is related to the initial condition chosen based on the plant inversion approach described 
earlier (either through the Laplace transformation or time domain solution). In Appendix 
A, it was shown for a single flexible link tracking a sinusoid, that the initial condition from 
the regulator approach is the same a s the one chosen to cancel all of the residues. We are 
currently seeking the generalization of this result. 


8 Adaptive Control 

The feedforward control in either set point or tracking case requires a great deal of model 
information. It is highly desirable to adaptively update this signal without requiring explicit 
knowledge of the plant parameters. To this end, consider the closed loop system as an 
internally asymptotically stable system driven by the input u jj. Based on our passivity 
approach, the closed loop system is passive but in general not strictly passive. Our basic 
idea is to choose a new output such that the I/O pair between the input u«-and this output 
is strictly passive. Then any passive adaptation for ujj r can be used to preserve the state 
asymptotic stability. 

We will only consider the linearized closed loop plant here, the full nonlinear version is 
under development. Suppose that the linearized closed loop plant is of the form 

x = Ax + B(u — u ff) 

where .4 is exponentially stable, ujf'is the unknown desired feedforward, and u is the adaptive 
feedforward. By the Lyapunov's theorem [39], for any Q > 0. there exists P > 0 such that 

A t P+ PA = -Q. 



Now define C = B T P as the new output map. Then the triplet (A, B,C ) is strictly positive 
real [40]. The adaptation for ujj is now straightforward. Using the standard linear-in- 
parameter formulation [41], suppose uq rcan be parameterized as 

HX 

where H in the known regressor matrix and A is the unknown parameter vector. For the set 
point control case, H = / and A is a constant vector. For the regulator approach, H contains 
w (state of the exosystem) and A consists of columns of F (cf. (94)). For the tracking of 
a general desired output, H depends on 9, 9, y des and its higher derivatives. In this case, 
finding the structure of H itself may be difficult. A viable approach may be to approximate 
H by some expansion and slowly adapt the approximation. The neural net approach in [42] 
is a possibility that we shall explore. 

To derive the adaptation rule, consider the Lyapunov function candidate 

V = x T Px + AA T r- x AA (99) 

where AA = A — A, A is the estimate of the unknown vector A. Since the output is chosen so 
the system is strictly positive real, the derivative along the solution becomes 

V = -x t Qx + 2(u - Uff) T y + 2AA r T- 1 i 

Choose the adaptive feedforward based on the estimated parameter: 

u = HX. 


(101) 

V is negative semidefinite. This implies that all states and parameter estimate error are 
bounded, and furthermore, by Barbalat’s Lemma [43], x converges to zero asymptotically. 
For the set point control case, the adaptive parameter update simply reduces to the integral 
control law. 

We are currently extending this argument to the nonlinear systems by using the nonlinear 
Lyapunov equation. 

9 Simulation Results 

To illustrate the results shown in this paper, we consider a simple one flexible joint robot. 
This model is taken from [44]. The dynamical equation is given by 

-mC% + B t 9 ( + ^sm9 t + k{9 e --9 m ) = 0 (102) 

3 2 n 

J m 9 m + Bj m --(9 ( --9 m ) = u. (103) 

n n 


Then 

V = -x t Qx + 2AX T {H T y + r _ 1 A). 
Hence, with the following gradient update rule for A: 

A = -TH T y 


( 100 ) 
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solid=SPR feedback, dashed=Iow gain PD, dotted=high gain PD 



Figure 1: Comparison between Link Angle Step Responses 


Numerical values used are (all quantities are in SI units): 

m = 10, g = 9.8, £ = .5, k = 100, n = 50, J m = .08. (104) 

The damping factors are assumed to be zero except for one of the tracking case. 

Fig. 1 and 2 show the step response (90° commanded link angle step) of the link angle 
and angular velocity under high gain PD (k p = k v = 5), low gain PD (k p = k v = .05), and 
SPR filter feedback. From these plots, it is evident that under high gain PD control the 
response of the closed-loop system, though stable, is highly oscillatory. Lower gain improves 
the overshoot and reduces the oscillation, but the best case corresponds to a fourth order 
positive real (PR) bandpass filter in parallel to the low gain PD, where the passband is 
roughly at the natural frequency of the spring. For this case, the transient is further slowed, 
but the residue oscillation is reduced by about 50%. 

The PR filter transfer function is given by where 

a(s) — s 4 + 75s 3 + 1925s 2 + 19125s + 56250 roots at {—30, —25, —15, —5} 
b(s) = 100(s 3 + 31s 2 + 230s + 200) roots at {-20, -10, -1} 

The phase and magnitude plots of this filter are shown in Fig. 3. It should be emphasized 
that virtually no tuning of this filter was carried out to optimize the performance. It was 
chosen basically to have a peak roughly at the resonant frequency of the linearized system. 

Fig. 4 shows the tracking of a cycloid over the same range. Since the desired trajectory 
eventually reaches a steady state, the set point control analysis can be applied. Fig. 5 shows 
the tracking of a slowly varying sinusoidal signal. By the analysis in section 7.0.2, it is not 
surprising that the actual and desired outputs. 6( and 0( dea , are virtually undistinguishable. 
When the desired sinusoid becomes too fast as in Fig. 6 (same as the one used in [44]). 
a significant error develops. This is as expected as the system remains I/O stable but no 
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solid=SPR feedback, dashed=low gain PD, dotted=high gain PD 



time (sec) 

Figure 2: Comparison between Link Angular Velocity Step Responses 






solid=actual, dashed=desired 



Figure 4: Set Point Control with Transient Shaping 


longer internally asymptotically stable. It should be noted that even in this case, the P R 
filter feedback has much less (by about 50%) error than the constant gain PD feedback. 

When the link damping is included, Bi = 36 as in [44] (but not motor damping), so the 
analysis in section 7.0.3 can be applied, faithful tracking is once again attained; the results 
are shown in Fig. 7. 

In all these cases, the same SPR filter as in the set point control case is used, except 
the feedback signal is now 9 m — 8m des instead of 9 m . These examples demonstrate, in a very 
preliminary sense, the possibility of tuning the SPR filter to attain an improved performance 
in terms of step response and the efficacy of using the feedforward for trajectory tracking. 


10 Conclusions 

In this paper, we derived a large class of asymptotically stabilizing control laws for a general 
class of mechanical systems typified by structures containing uncontrolled degrees of freedom 
which are elastically coupled to the controlled degrees of freedom. The idea is to first choose 
a feedforward to form an error system. Next a position loop is closed to obtain passivit}, 
stabilizability and detectability for a particular input/output pair. Then any strictly passive 
output feedback can be used to achieve closed loop stability. Through a simple example, it 
is shown that the dynamic nature of the feedback can be exploited to enhance performance. 
A systematic procedure for designing the feedback system for performance enhancement and 
adaptive update of the feedforward are currently under investigation. 
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Figure 5: Slow Sinusoid Tracking Control 
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Figure 6: Fast Sinusoid Tracking Control: Zero Damping Case 
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sol id =S PR feedback, dash=desired trajectory 



Figure 7: Fast Sinusoid Tracking Control: Nonzero Link Damping Case 
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Appendix A 


Consider the linear model for a flexible link, where, for simplicity, only one flexible mode 
is included: 


with 


q + 0 2 q = Bu 

Cq = y 


n- 


‘0 0 ' 
.0 u : 2 . ' 


B = 


X(0)' 

U’i(0) J 


q(<) = 


m] 

8{t ). • 


(105) 

(106) 
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Variable 9(t) denotes the rigid body displacement, £(t) denotes the flexible modal displace- 
ment, rpi(x) is the eigenfunction associated with the flexible mode and ' indicates the spatial 
derivative. 

For the output trajectory tracking problem, the desired output trajectory yd e3 {t) is given 
and the objective of the steady-state analysis is to find a desired state qd e3 {t) and feedforward 
such that 


qdei "H fl qdes — Bll ^ gr 
C<Jdes = Vdes- 

Consider the tip angular position as the output variable: 


(107) 

(108) 


(109) 


For this case study, the desired output trajectory is chosen to be a sinusoid yd e3 {t) = sin (w r t). 
For later use, we also define the following two matrices 


C + = 


1 + rp( 


1 

LtM 



where Vv 


0i (0 

t ' 


( 110 ) 


The purpose of this appendix is to derive u ^ using three different methods: regulation, 
Laplace transform, and time domain. We will show that all three methods lead to the same 
solution. 

Regulator method 

The desired output trajectory (sinusoid) can be generated by the following exosystem 


w = Sw = 


0 


l-Lu'r 

The solution to the linear 
solved in P and F. 



'Wi' 


. U>2. 


u;(0) = 


0 

1 1 


Vde, = QW = [ 1 0 j W. 


regulator problem requires the following matrix equations to be 


PS = AP + BF 
Q = CP. 

Equations (111) can be easily solved: 


D 

(u,r 2 -U- ? )/.V 
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— w ','0| 

(u r *-u;a)/JV+^f~ Wr 2 

M2 

Pn 

- l-fil. 

P 22 

^31 
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P 32 
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= o, 

PA2 

Ft 

— ^r 2 P 

'^(0) u ’ 

F: 
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Pi i 

Pn 
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(111) 
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:r> 


Therefore, the required solution is 


qde,{0) 


' 0 ' 

o 

P 32 

. Pa 2 . 

F x w x {t) = Fiyd e ,{t). 


(113) 

(114) 


Laplace transform method 

Following the procedure outlined in section 7.0.4 one obtains the following equation 


£(s) = (s 2 / + A) 1 (Lp{s) + s£(0) + £(0)) 


(115) 


u 2 -(j) t uj 2 y{s ) + Q pt ~ V , l(0)/V , o(0))y(-s)) 

■ 1 + fctf(o)M(o y " (1 + Mi(o)M(o))(i + ^ 2 ) 

For simplicity y(s) and t/(s) denote the Laplace transorm of the desired output trajectory 
and acceleration respectively. The f(s) has an unstable mode iff 

(l+^0)/<Ao(0))<0 

which corresponds to the condition for which unstable zero-dynamics exists (non minimum 
phase condition). For simplicity write 

tf 2 = -(1 + ^Mq(0)/i/>o(0)), 57=^-. with > 0, 

so that the poles can be written as 


S stable — ’ ^unstable — ^ i 


and the residues as 


* = 2*5 + + *’ H*P» + fto») (116) 

*• - ok + - - (^<°> + «°>)) - ‘ u7 ) 


To set both residues to zero the unique choice of initial conditions is 
-1 


f(0) = 


-[u 2 My(“) - $(-«)) + (i'l - ^(0)M(0))(y(uJ) - y(-u))](HS) 


f(0) = ■^r[w 2 V’<(y(w) + y(— w)) + — 0i(O)/0 o (O))(y(u;) + y(— w))], (119) 

2W(1 + ipt ) 

which, for the sinusoidal reference trajectory, become 


C . n , ;, n , - (vt t - ^(0)/^o(0)Vr 2 ) 

s(0) ’ m 'P 2 (l + ev 2 )p 2 +~v 2 ) 
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Note that if only the unstable residue is set to zero one only requires that 

[wV* - {i; i - Vq( 0)/^o(0))w r 2 


y£(0) + f(0) ®a( 1 + ^)( S ja +Wp a) 


(121) 


For this case, a natural question is how should the additional degree of freedom be used. A 
reasonable requirement would be that the initial flexible variables, 5(0) and 5(0), are set to 
zero. This cannot be achieved, as it would lead to a contradiction. 

To see how this solution relates to the regulator approach, note that 


q(t) = C + J/(I) + <?{(<)• 


Therefore, 


WO) 

Wo) 


= o, 


Wo) = o, 

v{ % - MW, L,(o) = + {(0) 

/ 1 


(122) 

(123) 


which, after some simple manipulations, can be shown corresponding to the initial conditions 
in the regulator approach, Ptu(0). 

Time domain method 

The state space representation of system (115) is 


-c. 


(124) 


where L is defined as 


-o;V < + u; r 2 (^-^ 1 (0)M(0)) 
(i + ^i(o)M(o))(i + ^ 2 ) ‘ 


The eigenvectors associated to the stable and unstable eigenvalues are 

r— ii r i i 

Vs — — i V u — — - i 

u J Lu; . 

so that the following diagonalizing change of coordinates can be done 


'7+' 
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UJ 
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In this new set of coordinates one has 


’7+' 


' hJ 0 

■7+' 

L 

H 
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. 0 — u7. 
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2 u 
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The initial condition 7+(0) is chosen to be 

-L 


_ —L r , -Lu r «0) 

7+ 0) = — / e w y{r)dr = ■ — = — 
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while 7_(0) is given by 


r»L ^ . m 


7-(0) = - / e~ T —y{r)dT = 
J — oo 2ZJ 


2uJ ' 2w 

Given these initial conditions, one can compute the time evolution and obtain 


7+(t) = 


-Le** f°° - 


r , ,, — L(u sin LJ r t + U T cos u> r t) 

y( T ) dr =2 - — - 

2u7(ur + ui T 2 ) 


j; 

7-c 


2u 

7-(t) = e' Ct 


Using the transformation T to compute (£,£), q(t) can be shown to be the same 
regulator solution 


i + = Pny{t) 

WO = Y^vW + m = Pny{t). 

The feedforward can be directly computed from the desired state: 

«//(*) = (B r S)- 1 B r fe,(<)+fl J fc,W) 

— ^q^(O) + V , 1 2 (0) "b V’o(^<fe* +W ydes(t ) = F\Vdts{P) 

which is again the feedforward from the regulator approach. 


(125) 

(126) 
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